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69 


•£ = ADE + BCE 


70 


gi = J(DFG-CH) 


71 


hi = J(DH+CFG) 


72 


i = J(BDH-ACH + ADFG + BCFG + I) + 1 


73 


2 2 
sin 0 + cos 0=1 


74 


0 = arctan(sin0, cos0) 



FIG. 32 
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EQ 
NUMBER 

■ « m mm mmw mmm m m 


EQUATION 

mmm *mw m » ■ ■ ^mw m m 


75 


^ = A(CG + DFH) + B(CFH - DG) 


76 


c = Aa + Bb 


77 


£ = A(DE) + B(CE) 


78 


/ = Ad + Be 


79 


i = AJ(DFG - CH) + BJ(DH + CFG) + IJ+1 


80 


i = Agi + Bhi + IJ + 1 


81 


c-Bb 

A = 

a 


82 


A - f ~ Be 
d 


83 


c-Bb _ f-Be 
a ~ d 


84 


cd — Bbd = af—Bae 


85 


B(ae — bd) = af— cd 


86 


B _ af- cd 
ae - bd 



FIG. 33 
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EQ 
NUMBER 


EQUATION 


87 


f ( a f— C( £\ 
f ~\ae-bd) 6 

A = d 


88 


1 _ Aae - bd) - e(af- cd) 
d(ae — bd) 


89 


^ aef—bdf-aef+cde 
d(ae — bd) 


90 


^ _ — bdf+ cde 
d(ae — bd) 


91 


1 _ -bf+ce 
ae — bd 


92 


r ei 
C " ES 


93 


D = ^- 
ES 


94 


a = -E G + ~E FH 


95 


b = i G + E FH 


96 


g = —H+—FG 
ES ES 


97 


d e 
ES ES 


98 


r eG + dFH 

E = 

a 


99 


„ -dG + eFH 
E= b 



FIG. 34 
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EQ 
NUMBER 


EQUATION 


100 


„ c -eH + dFG 
ES = 

g 


101 


£ 0 dH+eFG 
h 


102 


eG + dFH -dG+ eFH 
a b 


103 


FH ad + be 
G ae — bd 


104 


-eH+dFG dH+eFG 
g ~ h 


105 


FG _ dg + eh 
H dh — eg 


106 


FH FG _ (ad + be)(dg + eh) _ 2 
G * H ~ (ae -bdMdh- e2^ ~ 


107 


F _ + j(ad + be)(dg + eh) 
V (ae - bd)(dh - eg) 


1 uo 


E = ±Jl-F 2 


109 


(|) = arctan(ii, F) 


110 


1 w FH _ H _ f + \(ae - bd)(dh - eg)) . (ad + be) 
F G G V 4(ad+be)(dg + ehy ~ (ae-bd) 

h Had + be)(dh — eg) 

~4 (ae - bd)(dg + eh) 


111 


H H 1 



FIG. 35 
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EQ 
NUMBER 


EQUATION 


112 


H= ' 

+ 1+1 


113 


G = ±Jl-H 2 


114 


vj/ = arctan(G, H) 


115 


(e£) 2 J<*L) 2 = 1 
\ESJ \ESJ 


116 


S ±*]d 2 + 2 
i E 


117 


r - e * E 
E . L 2 2 


118 


c = A— 

j. L 2 ^ 2 


119 


n d E 
£> = x , 

E ^ b 2 2 
±4d +e 


120 


D. * 

, / ,2 2 



FIG. 36 
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EQ 
NUMBER 


EQUATION 


IZl 


i(l-Ag-Bh) = IJ+ 1 


122 


sign(0 = -sign(l - Ag-Bh) 


123 


y = arctan(D, C) 


124 


c di 
~ DE 


125 


b ~ CE 


126 


sign(F/f) = sign(^_^ 


127 


J = 


Ri 1 
- CH + sign(FH)DFG\ 


128 


y = 


hi 

DH + sign(FH)CFG 


129 


^ _ (i — Agi -Bhi — I) 

J 



FIG. 37 
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o 


o 


O 


±FJ 


O 


CFJ 


O 


±HJ 


DHJ 


±FGJ 


±HJ 


DHJ+ 
CFGJ 




o 


o 


O 


o 


±FJ 


DFJ 


±(-HJ) 


o 


-CHJ 


±(-HJ) 


±FGJ 


-CHJ+ 
DFGJ 


i= 


±BS 


±AS 


BS 


Bei 


Adi 


Adi+Bei 


±BS 


±AS 


Adi+Bei 


Bei 


Adi 


Adi+Bei 


"3 


±S 


o 


SO 


±ES 


o 


CES 


±S 


o 


SO 


±ES 


o 


CES 


t5 


o 


±s 


DS 


o 


±ES 


DES 


o 


±S 


DS 


o 


±ES 


DES 


"o 


±AS 


±(-BS) 


Aai+Bbi 


±AS 


±(-BS) 


Aai+Bbi 


Aai 


Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


2 


o 


±(-S) 


-DS 


o 


±(-S) 


-DS 


o 


±(-GS) 


-DGS 


±FHS 


±(-GS) 


-DGS+ 
CFHS 




±S 


o 


SO 


±S 


O 


SO 


±GS 


o 


CGS 


±GS 


±FHS 


CGS+ 
DFHS 




o 


o 


o 


o 


o 


o 


X 

o" 


X 

O* 


X 

0" 


X 

CD" 


X 
CD" 


X 
CD" 


u_ 

UJ 


o 


o 


o 


LL 
LU 


LL 
LU 


LU 
LU 


o 


o 


o 


u_ 

LU 


E,F 


U- 
LU 


Q 

o" 


±1,0 


0,±1 


C,D 


±1,0 


0,±1 


C,D 


±1,0 


0,±1 


a'o 


±1,0 


0,±1 


C,D 


case 


CO 




o 


(0 
CNI 


CM 


O 
CM 


CTJ 
CO 


CO 


o 

CO 


(0 




O 
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description 


case 


condition 


handling 


zero pitch & 
zero roll 


1 


g = h = 0 


E<- 1 

G<- 1 
//<- 0 


zero roll 


2a 


= d = g = 0 


£'< 

a 

FJ h 
S ~ a 


2b 


a = e = h = 0 


F/ _ 
5 ft 


2c 


a —h 
b~ g 


handle via 2a or 2b 


2 




G<- 1 

H<r-0 

F<-sign(y)7l-F 2 
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description 


case 


condition 


handling 


zero pitch 


3a 


b = d = h = 0 


e 

HJ _ -g 
S e 


3b 


a = e = g = 0 


* 

HJ _ h 
S ~ d 


3c 


« _ S 


handle via 3a or 3b 


3 




E<r- 1 

F<-0 

H= sign(^)7l-G 2 


non-zero pitch 
& non-zero roll 


4 


(g*0)A(/l*0) 


handle via general solution 



F/a 90 



